System and method for autonomous steering control of work vehicles

ABSTRACT

An electronic control system for a work allows for control of steering despite movement of an implement that may support a load. Control may be based on vehicle position, velocity, acceleration, center of gravity, and heading. A control point is determined despite movement of the load, and may be based upon one or more of roll, yaw, and pitch of the vehicle. The vehicle may be of the type that allows for control only of wheel or track speed and rotational direction. A desired center of gravity is maintained while controlling an error between a desired vehicle trajectory and a determined trajectory in a closed loop manner.

CROSS REFERENCE TO RELATED APPLICATIONS

This application claims priority from and the benefit of U.S. Provisional Patent Application No. 62/275,618, entitled “SYSTEM AND METHOD FOR AUTONOMOUS STEERING CONTROL OF WORK VEHICLES,” filed Jan. 6, 2016, which is hereby incorporated by reference in its entirety.

BACKGROUND

The invention relates generally to a system and method for autonomous control of work vehicles, particularly skid steer and similar vehicles.

Work vehicles, such as a skid steer loader, are increasingly being used on job sites. Skid steer loaders are typically used as general utility machines, due to their versatility and ability to operate on job sites having reduced amounts of surface area. Their short footprint and highly flexible steering are particularly attractive in such applications.

Despite their versatility, skid steer loaders may be configured differently to control attached implements, such as a blade or bucket, with which some work is performed. That is, the controls may perform different functions with respect to the implement, such as raising the arms of a blade or bucket, or rotating the implement about a rotational axis. These differences in different control implements and functions result in different centers of gravity based on the control implement attached. These variables may make it difficult to determine the vehicle behavior and control the vehicle.

Accordingly, to allow for better and more predictable control, it would be advantageous to determine the center of gravity of such vehicles and to regulate at least some operations (e.g., steering) based on the center of gravity.

BRIEF DESCRIPTION

The present disclosure relates to a work vehicle that includes a movable implement capable of translation relative to the vehicle in response to operator inputs to move a load. A plurality of driven wheels or tracks are controllable in rotational speed and direction for steering the vehicle. A plurality of sensors includes at least sensors for providing data indicative of vehicle position, velocity, acceleration, and heading. Control circuitry, in operation, receives the operator inputs and the sensor data, and controls driving of the wheels or tracks by determining a load on the implement, determining a control point of the vehicle, wherein the control circuitry regulates driving of the wheels or tracks to maintain a desired trajectory.

The present disclosure further relates to a work vehicle comprising a movable implement capable of translation relative to the vehicle in response to operator inputs to move a load, a plurality of driven wheels or tracks independently controllable only in speed and rotational direction for steering the vehicle, and a plurality of sensors, including at least sensors for providing data indicative of vehicle position, velocity, acceleration, and heading. Control circuitry, in operation, receives the operator inputs and the sensor data, and controls the speed and rotational direction of the wheels or tracks to maintain a computed a trajectory of the vehicle based in part on a control point.

The present disclosure also relates to a method for controlling a work vehicle comprising translating a moveable implement coupled to the work vehicle relative to the vehicle, receiving an operator steering input, and receiving sensor data indicative of one or more of vehicle position, vehicle velocity, vehicle acceleration, and vehicle heading. Based upon at least the load, a center of gravity, and the sensor data, a control point is determined. Driving of vehicle wheels or tracks is then controlled by determining the center of gravity of the vehicle, wherein the control circuitry regulates driving of the wheels or tracks to maintain a desired trajectory.

DRAWINGS

These and other features, aspects, and advantages of the present techniques will become better understood when the following detailed description is read with reference to the accompanying drawings in which like characters represent like parts throughout the drawings, wherein:

FIG. 1 is a top perspective view of an embodiment of an exemplary work vehicle that implements aspects of the techniques disclosed herein;

FIG. 2 is a side view of the work vehicle, illustrating certain sensors that may be used to determine data useful in determining and/or maintaining a desired center of gravity;

FIG. 3 is a flow diagram of an exemplary embodiment of a method for controlling the work vehicle;

FIG. 4 is a top view of a steering trajectory of the wheels of the work vehicle when the work vehicle travels in a curved trajectory; and

FIG. 5 is a top view of a steering trajectory of the wheels of the work vehicle when the work vehicle travels in a linear trajectory.

DETAILED DESCRIPTION

A system and method for automatically controlling the steering of a work vehicle and accounting for changes when the center of gravity of the work vehicle changes (e.g., as product is loaded and/or unloaded from the work vehicle) is described herein. The system and method for controlling the steering of the work vehicle include adjusting the trajectory of the work vehicle by using equations to predict the effects of several variables (e.g., x position, y position, heading angle, bias in rate gyro, right wheel speed, left wheel speed). The system and method include maintaining control of the vehicle based in part on a control point (e.g., a predetermined point on the work vehicle used to calculate a deviation of the vehicle from the desired point). The system and method for controlling the steering of the work vehicle also include taking various measurements to predict the vehicle trajectory, and to measure the actual trajectory. The error between the measured trajectory and the predicted trajectory is minimized by adjusting the steering of the wheels (e.g., right side wheels, left side wheels). In an illustrative embodiment, the system and method may include one or more controllers configured to translate a moveable arm the vehicle. The controller is configured to receive data indicative, for example, of a first position, a first acceleration, a first angular velocity, a first heading angle, and a first velocity. The controller then automatically controls the vehicle by determining a load, by identifying a center of gravity based in part on the load and the received data, and the control point. In particular, the controller may control wheels to adjust trajectory to maintain the trajectory of the work vehicle on the desired path.

Turning now to the drawings, FIG. 1 shows a work vehicle 10 having a frame 12 that is supported and moved by a plurality of wheels 14. Alternately, a track drive or other appropriate drive system may be used. A manipulating structure 16 includes an arrangement of structural members and actuators controllable by an operator (not shown), such as by an operator control 24 (e.g., a joystick or lever), to manipulate an implement 18 to perform work. As further shown in FIG. 1, the operator control 24 for controlling the work vehicle may be located within a cab. Frame 12 structurally supports the cab to at least partially surround the operator. A door 20 may provide operator ingress/egress to work vehicle 10, including a window or opening 22 through which an operator may view a work environment exterior of the work vehicle.

It is to be understood that the term “manipulating structure” as generally used here not only refers to the input device or devices (e.g., one or more joysticks, levers, etc.), but may also include various components, such as pumps, hoses, valving, fittings, hydraulic cylinders, hardware, and so forth to hold and move the implement, such as a bucket or blade, in a desired and controlled manner, both when the vehicle is stopped and when it is moving.

FIG. 1 further shows a plurality of axes and movements associated with respect to those axes as pertains to work vehicle 10. These axes and movements are provided to correspond to associated movements of implement 18 and the vehicle itself. For example, as shown, one axis 26 corresponds to a movement of the work vehicle in a longitudinal or “straight-ahead” direction. A rotational movement 28 of the implement about axis 26, sometimes referred to as “tilt” or roll. FIG. 1 also shows an axis 30 which corresponds to a lateral or side direction with respect to an operator seated inside the cab. For example, axis 30 may correspond to a left and right hand directions of movement or turning that are substantially perpendicular to axis 26. A rotational movement 32 of an implement about axis 30 is sometimes referred to as a “back-angle” or pitch. An axis 34 extends in a substantially vertical direction with respect to an operator seated inside the cab of the vehicle. A rotational movement 36 of the implement about axis 34 is sometimes referred to as “angle” or yaw. All of the rotational movements contribute to changes of the center of gravity, which impact the ability to control the work vehicle 10. In one embodiment, multiple sensors 38 are disposed on the work vehicle 10 to detect such movements. The sensors 38 may include, for example, load cells, speed sensors, accelerometers, wind sensors, vibration sensors, noise or acoustic sensors, force or resistance sensors, load level sensors, load tilt or angle sensors, load weight sensors, location stability sensors (e.g., motion caused by waves), or any combination thereof.

Data collected by the sensors 38 is used in part to determine one or more parameters useful in controlling the vehicle as it is moved during operation, such as a steering angle of the wheels of the work vehicle 10, its velocity, a load weight carried by the vehicle, slippage of the wheels, and so forth. The sensors may be positioned at various locations on the vehicle, as shown in FIG. 2. One or more controllers 40 may utilize the sensor data to adjust the direction of the wheels 14 based in part on the control point such that the trajectory of the work vehicle 10 is controlled despite different positions and movement of the vehicle and the implement.

FIG. 2 depicts a perspective view of the work vehicle 10, illustrating an embodiment of the position of sensors 38 (e.g., load cells) disposed on the vehicle. Traditional work vehicles (e.g., skid steer vehicles) include right side wheels 42 or tracks and left side wheels 44 or tracks. To steer the vehicle, the wheels 42, 44 are driven at different speeds and/or directions. If the weight distribution between the right side wheels 42 and the left side wheels 44 is identical, both the right side wheels 42 and the left side wheels 44 would have the same skidding trajectory and skidding velocity (assuming for now a straight-line trajectory). In this case, pivot points 46 of the associated right side wheels 42 and the left side wheels 44 are located at the center of the vehicle 10. In the illustrated embodiment, the weight distribution between the right side wheels 42 and the left side wheels 44 is often uneven, resulting in a changed center of gravity and changed pivot points 46. In general, according to the present techniques, the pivot points 46 of the work vehicle 10 are dependent on the center of gravity of the work vehicle 10, among other factors. The mass and stability of a load 56 and the position of the implement, the load, and the lever arms supporting the implement also affect the center of gravity.

The navigation of the work vehicle 10 is controlled by the controller 40. It should be noted that while the term “controller” is used in the present discussion, in practice, the “controller” may consist of one or more independent or cooperating units, which itself or themselves comprise processing circuitry, memory circuitry, input and output components, control signal generating and output components, and so forth. For example, the controller 40 may have a processor 52 (e.g., multiple microprocessors, one or more “general-purpose” microprocessors, one or more special-purpose microprocessors, and/or one or more application specific integrated circuits (ASICs), system-on-chip (SoC) device, or some other processor configuration) and memory 50 (e.g., random access memory, read only memory, flash memory, volatile or non-volatile memory, hard drive, etc.). The controller 40 is configured to store instructions (e.g., code) in the memory 50 and to execute the instructions via the processor 52 to control operation of the work vehicle 10. In particular, the controller 40 may execute instructions to control the wheels 42, 44 to provide a stable rate of movement in one or more directions 54 (e.g., linear or rotational movement) based, for example, on a size, weight, shape, or other characteristics of the load 56, the stability of the locations (e.g., pushing through ground or various impediments), and so forth. For example, the controller 40 may communicatively couple to various sensors throughout the work vehicle 10 and use sensor data to improve the movement of the vehicle and load. As described above, the sensors 38 may include load cells, speed sensors, accelerometers, wind sensors, vibration sensors, noise or acoustic sensors, force or resistance sensors, load level sensors, load tilt or angle sensors, load weight sensors, location stability sensors (e.g., motion caused by waves), or any combination thereof. In the illustrated embodiment, the sensors 38 are disposed on the central shaft for the rotating wheels (e.g., axles 58). However, it should be appreciated the sensors 38 can be located along the pivot points 46, the rotatable arm 37, the frame 12, and so forth. The controller 40 also may include a user interface or control panel having a display (e.g., LED, LCD, or touch screen display), user inputs (e.g., buttons, keypad or keyboard, touchpad, mouse, etc.), outputs or alerts (e.g., audio or visual alarms), or any combination thereof. These may be integrated into or utilize existing operator controls.

The operator instructions (e.g., load control and steering inputs) and data (e.g., sensor feedback) received by the controller 40 may be utilized to generate state estimates of the work vehicle 10, including but not limited to, the work vehicle position, heading angle, bias in the rate gyro, right wheels and left wheels velocity, steering angle, a pitch angle, a roll angle, a yaw angle of the work vehicle 10, or a combination thereof, as well as rates of change of any one or more of these (e.g., first and/or second derivatives). As used herein, “position” (e.g., determined position, target position, etc.) refers to a position vector, such as a one, two, or three-dimensional position vector. For example, a two-dimensional position vector may include latitude and longitude, and a three-dimensional position vector may include latitude, longitude, and altitude/elevation. As will be appreciated, the position vector may be represented in a rectangular, polar, cylindrical, or spherical coordinate system, among other suitable coordinate systems, and may be determine and manipulated in one or more dimensions. In addition, as used herein, “velocity” (e.g., determined velocity, target velocity, etc.) refers to a velocity vector, such as a one, two, or three-dimensional velocity vector. For example, a one-dimensional velocity vector may include speed and direction in one direction only (e.g., ground speed), a two-dimensional velocity vector may include speed and direction in more than one direction (e.g., ground speed) and heading within a plane (e.g., along a ground plane), and a three-dimensional velocity vector may include speed and heading within three-dimensional space. Similar to the position vector, the velocity vector may be represented in a rectangular, polar, cylindrical, or spherical coordinate system, among other suitable coordinate systems. In certain embodiments, the velocity may be represented as a unit/normalized vector, i.e., a vector having a unit magnitude. In such embodiments, the magnitude (e.g., speed) is not included in the velocity vector. For example, a two-dimensional velocity unit vector may be representative of heading within a plane (e.g., along a ground plane), and a three-dimensional velocity unit vector may be representative of heading within a three-dimensional space. Similarly, in some embodiments, speed alone in one or more directions may be determined and manipulated for one or more aspects of the control described.

The controller 40 may utilize a model to predict the motion of the work vehicle 10 as described below:

$\begin{matrix} {\mu_{t} = {{g\left( {u_{t},\mu_{t - 1}} \right)} = {\mu_{t - 1} + {\Delta \; {t\begin{bmatrix} {{v_{v}\cos \; \theta} + {d\frac{\Delta \; v}{w}\sin \; \theta}} \\ {{v_{v}\sin \; \theta} - {d\frac{\Delta \; v}{w}\cos \; \theta}} \\ {k_{sf}\frac{\Delta \; v}{w}} \\ 0 \\ 0 \\ 0 \end{bmatrix}}}}}} & (1) \end{matrix}$

where the variables are defined as

Δv=v _(r) −v _(l)

v _(v)=0.5(v _(r) +v _(l))

d=rotationCenterOffset

k_(sf)=spinSlipFactor

w=trackwidth

θ is the heading.

Equation (1) provides a new estimate of each state component, based on the previous estimates and based on a time increment of Δt. Thus, the first component of the equation is the new work vehicle position, the second is the new heading angle, and so forth. A forward speed of the work vehicle 10, v_(v) is projected onto the x-axis by multiplying v_(v) by cos θ, where θ is the heading angle of the work vehicle 10.

In embodiments where the work vehicle 10 rotates off-center, the center point motion is different from simple rotation. The second term in the x component accounts for pivoting at a point that is not at the center of the vehicle. The rotationCenterOffset, d, is the offset along the x-axis of the work vehicle 10 relative to a control point (e.g., the center of the work vehicle 10). For example, as the vehicle turns left about the pivot point 46, the center point moves. The x and y components are affected by the amount shown in equation (1). As a final step, the result is multiplied by Δt to determine the change in position, which is added to the initial velocity to produce the new estimate of the velocity. In the illustrated embodiment, a velocity of the work vehicle 10, v_(v) is projected onto the y-axis by multiplying v_(v) by cos θ, where θ is the heading angle of the work vehicle 10 and can be understood in an analogous manner.

The angular velocity Δv/w of the work vehicle 10 is multiplied by Δt to produce the predicted increment in heading. The angular velocity Δv/w is multiplied by a slip factor, k_(sf) to account for wheel slip that the work vehicle 10 may experience. The resulting value is then added to the previous heading estimate to provide the new estimate.

Certain components of the state vector may “drop out” of the calculations. For example, the fourth component provides the “new” estimate for the gyro bias b. In the illustrated equation, the new prediction for the gyro bias b remains unchanged from the previous estimate. Because of this, a Kalman filter may rely purely on measurement updates to estimate the gyro bias b. Similarly, the fifth and sixth components for wheel velocity may remain unchanged. In the illustrated embodiment, the model can also be provided with an input u, which can be seen on the left-hand-side of the equation. However, no input is used in the current implementation.

The controller 40 may utilize another model for measuring the motion of the work vehicle 10 as described below. Measurement of the motion may be described as z_(t)=h(μ_(t)). The motion measurement may take the form:

$\begin{matrix} {{h\left( \mu_{t - 1} \right)} = {\begin{bmatrix} x_{gps} \\ y_{gps} \\ {\overset{.}{x}}_{gps} \\ {\overset{.}{y}}_{gps} \\ {\overset{.}{\theta}}_{imu} \\ v_{l} \\ v_{r} \end{bmatrix}_{t} = \begin{bmatrix} {x + {q_{x}\cos \; \theta} - {q_{y}\sin \; \theta}} \\ {y + {q_{x}\sin \; \theta} + {q_{y}\cos \; \theta}} \\ {v_{x} - {\omega \left( {{q_{x}\sin \; \theta} + {q_{y}\cos \; \theta}} \right)}} \\ {v_{y} + {\omega \left( {{q_{x}\cos \; \theta} - {q_{y}\sin \; \theta}} \right)}} \\ {\omega + b} \\ v_{l} \\ v_{r} \end{bmatrix}}} & (2) \end{matrix}$

where, (q_(x),q_(y),q_(z)) is the GPS offset from the control point. The GPS offset is defined using a standard Cartesian coordinate frame with the control point at the origin and the x-axis out the front of the vehicle, the y-axis to the left and z-axis up. This offset needs to be rotated into this frame before these equations are valid. The x and y velocities and yaw rate used in the computation are computed using:

v_(x) = v_(v)cos  θ v_(y) = v_(v)sin  θ $\omega = {\frac{\Delta \; v}{w}.}$

To minimize error between the prediction of the motion of the work vehicle 10 and the measurement of the motion of the work vehicle 10, derivatives of equations 1 and 2 with respect to the state vector may be represented as:

${{G\left( {u,\mu} \right)} = \frac{\partial{g\left( {u,\mu} \right)}}{\partial\mu}},\mspace{31mu} {{H(\mu)} = {\frac{\partial{h(\mu)}}{\partial\mu}.}}$

The values of these matrices are:

${G\left( {u,\mu} \right)} = {I_{6} + {\Delta \; {t\;\begin{bmatrix} 0 & 0 & g_{x\; \theta} & 0 & g_{{xv}_{l}} & g_{{xv}_{r}} \\ 0 & 0 & g_{y\; \theta} & 0 & g_{{yv}_{l}} & g_{{yv}_{r}} \\ 0 & 0 & 0 & 0 & g_{\theta \; v_{l}} & g_{\theta \; v_{r}} \\ 0 & 0 & 0 & 0 & 0 & 0 \\ 0 & 0 & 0 & 0 & 0 & 0 \\ 0 & 0 & 0 & 0 & 0 & 0 \end{bmatrix}}}}$

where I₆ is a 6×6 identity matrix and the matrix elements are

$\begin{matrix} \begin{matrix} {g_{x\; \theta} = {{{- v_{v}}\sin \; \theta} + {d\frac{\Delta \; v}{w}\cos \; \theta}}} & {g_{y\; \theta} = {{v_{v}\cos \; \theta} + {d\frac{\Delta \; v}{w}\sin \; \theta}}} \\ {g_{{xv}_{l}} = {{0.5\; \cos \; \theta} - {\frac{d}{w}\sin \; \theta}}} & {g_{{yv}_{l}} = {{0.5\; \sin \; \theta} + {\frac{d}{w}\cos \; \theta}}} \\ {g_{{xv}_{r}} = {{0.5\; \cos \; \theta} + {\frac{d}{w}\sin \; \theta}}} & {g_{{yv}_{r}} = {{0.5\; \sin \; \theta} - {\frac{d}{w}\cos \; \theta}}} \\ {g_{\theta \; v_{l}} = {- \frac{k_{sf}}{w}}} & \; \\ {g_{\theta \; v_{r}} = \frac{k_{sf}}{w}} & \; \end{matrix} & \; \\ {and} & \; \\ {{H\left( {u,\mu} \right)} = \begin{bmatrix} 1 & 0 & h_{x\; \theta} & 0 & 0 & 0 \\ 0 & 1 & h_{y\; \theta} & 0 & 0 & 0 \\ 0 & 0 & h_{\overset{.}{x}\; \theta} & 0 & h_{\overset{.}{x}\; v_{l}} & h_{\overset{.}{x}\; v_{r}} \\ 0 & 0 & h_{\overset{.}{y}\; \theta} & 0 & h_{\overset{.}{y}\; v_{l}} & h_{\overset{.}{y}\; v_{r}} \\ 0 & 0 & 0 & 1 & h_{\theta \; v_{l}} & h_{\theta \; v_{r}} \\ 0 & 0 & 0 & 0 & 1 & 0 \\ 0 & 0 & 0 & 0 & 0 & 1 \end{bmatrix}} & \; \end{matrix}$

where the matrix elements are:

h _(xθ) =−q _(x) sin θ+q _(y) cos θ

h _(yθ) =q _(x) cos θ+q _(y) sin θ

h _({dot over (x)}θ) =−{dot over (y)}

h _({dot over (x)}v) _(l) =0.5 cos θ−(q _(x) sin θ+q _(y) cos θ)/w

h _({dot over (x)}v) _(r) =0.5 cos θ+(q _(x) sin θ+q _(y) cos θ)/w

h_({dot over (y)}θ)={dot over (x)}

h _({dot over (y)}v) _(l) =0.5 sin θ−(q _(x) cos θ−q _(y) sin θ)/w

h _({dot over (y)}v) _(r) =0.5 sin θ+(q _(x) cos θ−q _(y) sin θ)/w

h _(v) _(l) _(v) _(r) =−1/w

h _(v) _(r) _(v) _(l) =1/w

The covariance of the state vector is then estimated at a time t, denoted by the matrix P. The noise in the process model at a time t is represented by the covariance matrix R_(t) and the sensor noise at a time t is represented by the covariance matrix Q_(t). The discrete extended Kalman filter for this implementation may have the form:

μ _(t) =g(u _(t),μ_(t−1))

P _(t) =G _(t) P _(t−1) G _(t) ^(T) +R _(t)

K _(t) =P _(t) H _(t) ^(T)(H _(t) P _(t) H _(t) ^(T) +Q _(t))⁻¹,

μ_(t)=μ _(t) +K _(t)(z _(t) −h(μ _(t)))

P _(t)=(I−K _(t) H _(t)) P _(t)

where K_(t) is the Kalman gain. The subscripts of t indicate that the values are at time index t, while a bar over a matrix or vector indicates an intermediate quantity. Equation (1) (e.g., prediction equation) can be executed independently of equation (2) (e.g., the measurement equation). The measurement equation is executed when new measurements are available, unless otherwise instructed via the user interface. After the prediction equation and measurement equation are executed, numerous estimates can be obtained by iterating through the estimates. It should be appreciated that, in a typical implementation, the previous estimates will be the input variables for the current state to obtain the new values.

FIG. 3 is a flow diagram of an embodiment of a method 100 for controlling the work vehicle 10. The method 100 includes translating a moveable arm of the work vehicle 10 (e.g., a skid steer vehicle) as needed as the work vehicle 10 is used in operation (block 102). The work vehicle 10 may be used for moving material, raising, lowering, loading and unloading various loads and materials, or any other suitable purposes depending on the attachment. The method 100 includes receiving data or a first signal or signals indicative of the positions of the right side wheels and the left side wheels (block 104). As described above with respect to the discussion of FIG. 2, the first signals may include a first position, a first acceleration, a first angular velocity, a first heading angle, and a first velocity of the work vehicle 10, or any combination thereof. The method 100 includes determining a control point and a center of gravity of the work vehicle 10 from data provided by the plurality of sensors disposed about the work vehicle 10 (block 106). Here again, the sensors may include speed sensors, accelerometers, wind sensors, vibration sensors, noise or acoustic sensors, force or resistance sensors, load level sensors, load tilt or angle sensors, load weight sensors, location stability sensors (e.g., motion caused by waves), or any combination thereof. The method 100 includes instructing the right and the left wheels to account for a new center of gravity (e.g., a deviation from the control point) (block 108) based on a new estimate including factors affecting the trajectory of the right and the left wheels, and of the vehicle in general. The method 100 includes determining whether a new measurement has been received (block 110). If a new measurement has been received, the previous step (block 108) is repeated. If a new measurement has not been received, the parameters affecting the right and the left wheels are maintained (block 112).

FIGS. 4-5 are top views of a trajectory of the vehicle 10 and wheels 14. FIG. 4 is a top view of the pathway of the trajectory of the wheels 14 (e.g., right wheels 42, left wheels 44) of the work vehicle 10 when the work vehicle 10 travels in a curved trajectory. The controller is configured to automatically adjust the trajectory (e.g., speed, direction, steering) of the wheels 14 of the work vehicle 10 based in part on the control point. When following a curve, the controller 40 uses several variables to determine the desired curvature of the trajectory. The variables may include, but are not limited to, a vehicle position (e.g., x, y coordinates on a Cartesian coordinate frame), radius of the arc of the work vehicle path, and heading angle of the work vehicle 10. An error in trajectory tracking and a time derivative associated with the error can be calculated. The controller uses these variables, such as to calculate a desired curvature to direct the work vehicle towards the desired steering trajectory. FIG. 5 is a top view of the pathway of the trajectory of the wheels 14 of the work vehicle when the work vehicle 10 travels in a linear trajectory. The same variables described with respect to the discussion for FIG. 4 may be used to adjust the trajectory of the work vehicle if a linear trajectory is desired. An error in trajectory tracking and a time derivative associated with the error can be calculated. As the work vehicle 10 proceeds along its desired trajectory, the controller adjusts automatically the speed, direction and/or steering angle of the wheels 14 in order to move the work vehicle along the requested (e.g., curved, linear) pathway based in part on the control point. In a presently contemplated embodiment, the controller calculates proportional gains and derivative gains and automatically adjusts the trajectory of the work vehicle to keep the error values within an acceptable threshold range. In practice, such gains may include one or more of proportional gains, derivative gains, integral gains, and other gains that aid in smooth and accurate control of the trajectory despite changing dynamics caused by the presence and movement of the load.

While only certain features of the invention have been illustrated and described herein, many modifications and changes will occur to those skilled in the art. It is, therefore, to be understood that the appended claims are intended to cover all such modifications and changes as fall within the true spirit of the invention. 

1. A work vehicle, comprising: a movable implement capable of translation relative to the vehicle in response to operator inputs to move a load; a plurality of driven wheels or tracks controllable in rotational speed and direction for steering the vehicle; a plurality of sensors, including at least sensors for providing data indicative of vehicle position, velocity, acceleration, and heading; and control circuitry that, in operation, receives the operator inputs and the sensor data, and controls driving of the wheels or tracks by determining a load on the implement, determining a control point of the vehicle, wherein the control circuitry regulates driving of the wheels or tracks to maintain a desired trajectory.
 2. The work vehicle of claim 1, wherein the sensors provide data for determining a position of the load.
 3. The work vehicle of claim 1, wherein the plurality of sensors comprise load cells, speed sensors, accelerometers, wind sensors, vibration sensors, noise or acoustic sensors, force or resistance sensors, load level sensors, load tilt or angle sensors, load weight sensors, location stability sensors, GPS sensors, or any combination thereof.
 4. The work vehicle of claim 1, wherein in operation the control circuitry receives a user input that is utilized to determine the load.
 5. The work vehicle of claim 1, wherein a user interface is communicatively coupled to the control circuitry and is configured to selectively instruct the control circuitry to automatically control the direction of the work vehicle based on an operator input.
 6. The work vehicle of claim 1, wherein the data comprises a steering angle, a pitch angle, a roll angle, a yaw angle, or any combination thereof, and the control circuitry is configured to adjust a desired trajectory based on the steering angle, the pitch angle, the roll angle, the yaw angle, or any combination thereof.
 7. The work vehicle of claim 1, wherein translation of the implement is based in part on a position of the load.
 8. A work vehicle, comprising: a movable implement capable of translation relative to the vehicle in response to operator inputs to move a load; a plurality of driven wheels or tracks independently controllable only in speed and rotational direction for steering the vehicle; a plurality of sensors, including at least sensors for providing data indicative of vehicle position, velocity, acceleration, and heading; and control circuitry that, in operation, receives the operator inputs and the sensor data, and controls the speed and rotational direction of the wheels or tracks to maintain a computed trajectory of the vehicle based in part on a control point.
 9. The work vehicle of claim 8, wherein the control circuitry implements a discrete Kalman filter to determine reduce noise in computing at least one control parameter.
 10. The work vehicle of claim 8, wherein the plurality of sensors comprising load cells, speed sensors, accelerometers, wind sensors, vibration sensors, noise or acoustic sensors, force or resistance sensors, load level sensors, load tilt or angle sensors, load weight sensors, location stability sensors, GPS sensors, or any combination thereof.
 11. The work vehicle of claim 8, wherein the wheels are controlled and a center of gravity is maintained by closed loop control of a desired vehicle trajectory.
 12. The work vehicle of claim 11, wherein the vehicle trajectory is controlled based upon an operator input and upon the sensor data despite a position of the implement and/or the load.
 13. The work vehicle of claim 8, wherein the data comprises a steering, a pitch angle, a roll angle, a yaw angle, or any combination thereof, and the control circuitry is configured to adjust a desired vehicle trajectory based on the steering angle, the pitch angle, the roll angle, the yaw angle, or any combination thereof.
 14. The work vehicle of claim 8, wherein control of speed and rotational direction of the wheels or tracks accounts for translation of the implement and/or the load.
 15. A method for controlling a work vehicle, comprising: translating a moveable implement coupled to the work vehicle relative to the vehicle; receiving an operator steering input; receiving sensor data indicative of one or more of vehicle position, vehicle velocity, vehicle acceleration, and vehicle heading; determining a control point of the vehicle based upon at least the load, the sensor data, and a center of gravity; and controlling driving of vehicle wheels or tracks by determining the center of gravity of the vehicle, wherein the control circuitry regulates driving of the wheels or tracks to maintain a desired trajectory.
 16. The method of claim 15, wherein the wheels or tracks are controllable only in speed and rotational direction.
 17. The method of claim 15, comprising receiving a user input and determining the load based on the user input.
 18. The method of claim 15, wherein the the operator steering input comprises a desired vehicle trajectory and is received via a user interface communicatively coupled to control circuitry, and wherein the wheels or tracks are controlled to reduce a trajectory error between the desired vehicle trajectory and a trajectory determined by the control circuitry.
 19. The method of claim 18, wherein the determined trajectory is based upon at least one of steering angle, pitch angle, roll angle, and yaw angle.
 20. The method of claim 19, wherein the center of gravity is determined in three-dimensional space. 